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(54) ACTUATOR DRIVE CONTROL SYSTEM, MULTIAXIAL MACHINE DEVICE AND 
DRIVE CONTROLLER FOR ACTUATOR 

(57) Abstract: 

PROBLEM TO BE SOLVED: To synchronously drive 
plural actuators by short-time serial communication. 
SOLUTION: Each drive system has a data input part 
for one set and a data output part for one set and one 
daisy chain connection constitution is formed 
between adjacent driving systems, by connecting one 
data output part to the other data output part. The tip 
of the daisy chain is connected to a data output part 
of a central controller and the rear end is looped back 
to the central controller. Instruction data to respective 
driving systems are transferred by a bucket relay 
system. Respective drive systems temporarily stand 
by after receiving instruction data, and at inputting of 
a synchronizing control clock signal from the central 

controller, they synchronize respective control states and synchronously execute 
processing of the instruction data. 
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sow zmwr hi&xvrv+a.*--* wmm^ 

BtrE^^n yhn-7il MIBffl5««&ff (KOjfefflfcffl 

nmm 2 3 hjb^ u r;wwix{4»iai$^ u r/uii 

tB»«T7^x-^lg»$iJl»7J^o 
[ ffi&g 3 3 £ <^ fc mfl5^ 3 y h a- ?&tfBttffimi 
gp«#* fcM LT^fflco? a >y ? ftlfr*-* ? a -y 

Kmmmmmzm^ : T-?*mi-T& 1 1 & tc, fflie 
#r ? f - ax- * tn^T- ? £ s&fr*-* 

mriaiiH»$iJfflig|50#^ &jK^££OT*8m^gti: £ 
JlffU 

mm i/ v r >vmm t ± *} ss*t- ? ?? 3 mm 

miS^^x? y h n-^f 4fg? o -y ?m^z X -o T:H5£$ 



9 a -y ^fl^-Sr A JJt-|> ^ o -y ^ ATJ^Kt , 

Mie®a§i3(i a* Ltz^U'y^^zx-oxm&^timm 

[ff*ll8] H?ilB7 ; '--^A7J#ffiS.t/'7 ; "-^m7J^® 
^ f- ax- ? O^AOffMMWRK. 

t- ^ ffi**g«c«i(pirirc* s fc k «> (c. frier- ^ 
mx-h h z t zmtk -t&msm 7 tamor 9 * *x 

[00013 

J»CW t T $ T ? f - *x - ^ IUHflKicfli 
0, «^r^f-ax-^fcRJB|»«fc:W«it 

[000 2 3 Efc»U< 14, *flMH«. >-'J r/WM* 
fflv^ifcT, ^v>ffiB3ftfcJ;-5T«3S<Dr^rAX 

i^r, «m^r^rj.x-^^isi»f»<j^sg«j-r-g. 

ik^'T# *T^f-AX-^gHWH«ttrSfcBW4. 
[00033 

bj kV>-3„ hC0|§llg(4 s ^.77'lScOROBOT 

54. n*'-y h3W&Ltt«>/£<0ti 1 9 6 0*ft5fc&»4>T 

tcbcOMM^'at^y b (industrial rob 
o t ) Xhh. 

[0 0 04 3 otf'-y hit. HRfc«» WWi*JK**S 
IfctfJfl #2" 7 ^ - F A-y ^ L** 1 feffiSt«Bl "9^X7^ 



TUS. £<A=, W3yhn-5*\ nAvr-AF^S 
<0i&ft5/ y £ Htff S J; 5 tc . n # -y h A#Wlg» 

[0005] %mtth%£WL<vmm%kzwr>a7ii<y h 

ih«Lt\ mz, AilD^'y h^.y h • nA* 

a** & v * t &mm®mmiztt lx l a v k a 

l> . 4 A . IS«iffijgia<Offi» i) M3f LX L A -5 . 4 A , 
T ? A *x— ^ Afifi^T* Si, n # >y h ^flscoSS 

oTL43. 

[ 0 0 0 6 ] Witf, *IHKA(cKWKBI[S*i.T^*» 
Bffll-3338 6fBW*tli. ATl£l£lA-fio 

®L^^-<Tc0/JnMAC-9-— ^ • 7^faX-^(:on 
-Cg§A£A?V>S. iACt-^f- T^AaX-^U:, 

[0007] 4 a. oaa hco£ o %&wm&e>WM 

AS^Wa&S. ASMndf-y h<o«fc -5=5:2 J£ 

iSiLSOP^ t& u # -y h K fc V ti , 
iWtl^frAAAAfcA utf'-y Hi^<73gc5SK£ A? 

fifiltiOa^ rA*««AWI£MS^ttA 

&s u nzmizi. ^xmm-hM^m^m^wmtf 

[0008] ^MnsKy T-#\ ±»Ui J: a (=ffiK<0K 
IJjiRi: loc7)4 : i*:3^hn-5tT-«)!5;§ti.-I.J;d^« 

at** Lxmim^zmi zt^zx^x, itmmmmz 

xmrnizmffi^zmr-tz ztizx^x. ®mzmw 
tfthti. &T?^^-9\iz&h±%mm%Mfc* 

[0 0 0 9] U^L&^'A cf3*3yfo-7t^<?) 
£ ^(6<J lc«SR £ -£A tOTti . 4> A 3 >- b a - ^ 

3yfo-7 g*«f£it t Kit A D n x MiASr fflv > 
TL4A 4A, @Efe«<DtMA(A ^yfn-^O 

fc AS , 
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[0010] *Any hn-5t£*J»t4i»«a»t*» 

• ^x-yAATittSLTV A ; kTft* 

■5 „ 

[001 1] y'J T^uafi&Cii, RS (Recomme 
nded S t a n d a r d ) - 2 3 2 CCD J; 3 ^DH^ 

[0012] BU*<7)W#|BISJi:<i, X^- h ■ h'>y hX 
*) X b -y 7° • t" -y h T»*>« FifySS^b" 7 h 

h -y r • b" >y h ^^|±i LTSft-f-^ trligfJAS Ai^T- 

j) 0 , fLJt a y r u >- jrwaarc t •/ h n z 
^compmrnnmi, mmmi e &<. ttc. mm 

T— ^(4A S C I I ( Am erican Standa 
rd Code for Information I 
nterchange) 3— VlZlfedfcMZf 

A^T-A-f i>- • fx-y^St, #W«AS« 
A-^S:PSflLT^TASkV^fSfiE*^v^ 4fc. gg 
Wil^BSIBBcte JfcW t T ®^ra#'«A LT L4 -5 . 

[0013] fiilA, USB (Universal Se 
rial Bu s ) fcft*l3*tS i O^W^UT/Wl 

S«Cj:bMtTgeftAt«AtTL4 d. UA-^T, 
3h *SI«ffl A 4 k SK^aUC L , Kl t AfflU k 
AS« 

[0014] 4Jt. ±ie waa^ imwifi a^t- 

[00 15] TOB&filSW-i/tWXctt. 4>Anvhn- 
ilfl«l»»lk T/'f aX-^ <olii&$MMJl k 
v^MA^^r-^-^-y HSr*bTL4a. 

A'feALTL4v\ axb -A^t-vyx^tL 
[00 16] 

[ WBiMIHift L J: -5 k A S ISffl 3 A^a^O S Wti , n # 

^Mtt iJ»^a A if <9 £ 5 SrSfJ&O T ? f - * x - * T« 
$ixSS«^a^M LTiifflAS Z t ATA S , mtifz 
\ T^Aj.x-^|g»W»A^t««AS^ktS>S. 
: [0017] *«WOJM:*BW{i, »7?faX 

•-^*l^8I1«H»t=IBaW-S -r k AAA h . flHtfcT^ 
^ AX-^WSJPA^^SfftAS .1 fc tc* 6 . 

[0018] *^h>iws*s ae^fi. y u nmrn^m 



'■(A) 001-147706 (P2001-147706A) 



*x.-9mmwy&*mk-ti> £ k £ & 4 . 

[0019] *»W55Rr6 BWtts ®B#^v-U 
[00 20] 

T^fai-^*>W4 ^ffl «i«l£fi«» * fM«-r 4 

ii- ^ 4 ffi^-r- ? £ flirt 4 > h d- 
9k, ^7--^(^-5TT^-f-AX-^«7)|g»2r$rJfflI 
-th , #T ? f - * x- ^«{c»tt ^*UfeWWW«W k T" 

4 t — ^A^fst s^- * * Jifi-r 4 7*-^ 
jfcv^-fxts^mztmz fix ^4 • fi-ys 

iwlB^i^ybo— mrfB-r'-f Z J— ■ f-* 
-ycoJtSBtcfgjST-^Sri^ttl-t'4, Clfc£#t8fc-*-S 

[002 1] afs&HHOSS 1 <7HHJHWM4 7?f.iX-^ 
SaSfJfflttf^Cti:. USB (Universal Se 
rial Bus) £-ft3t£ ft-4 <fc 3 ^rlBM^ U T/W» 
ft, Xfct RS- 2 3 2Cfc«^2ti4J:-5^P#(Hlffi 

Tf^v 2 '— ^cOftjMSrfi : oii:* i 'T'#4o y'J7;l" -f 

[00 22] ifc. S^fcMiB'^ny ho-9&ltf§B 

P -y ? imiZ «t o T*U£ § *l 4 ttMBJBMCffi^x- ? 
frfftfM-* k k fc (=. WBBBBMWSfco^^JiMWJIIIB 

[0023] WskT~?% y V r;HEJ*-r4 Z.kt,z£ 
0 . #lg»$iJ»g|5» ; KT-^^gffrr4«i:E^ k 

& 4 # * MffAon tc mm l t -^tc^x- * *>*yi £ 
Hff-r 4 i t iz x o . #7?tax- ? oiHiwemofs 

[0 0 24] #3fcBlto& 2 Officii. IfflKDT? 

x- ? tc^4 jg^rr - ? £ "t 4 4>^^ 
4, ^T^-f-jt.x-^ttfciftJt'bixfclHWWflWi:, ffl 

iaiWJ»gp<7)#^ ■ -f-x- vassw-siBtt 

n-?c7)m^~?ttfjmzmi;zti&tki>iz^ mm 



mm^mcoffimim ae** y r u - ^ co^x- * 

$>4. 

[0025] 2<0MHi=«4^W«t^iafc 
*JV^"C s ffi&Hg&&!l*s USB (Universal 
Serial B u s ) tcft*$ix4 J: 3 StUM^U 
T/Wlft. RS-2 3 2Ct;_ftSl£ix4 j^Srtra 

t,z X i TftSs7*— ^0(B**tf oik 4 . y'J7 

-■fx-y»i«;t(:J;^ IMS 4 

i k^<^x-^ ^rlgjMf 4 CI k !&*C* 4 . 
[00 26] $^>^irlfi4'A3yha— 9St/'|g 
««ij»il50#-<?t*f LXimco? u -y ^fl-^2rt^-T4 

n >y ?mmz£ ixm%.ztiz>fflM®nmzm* : r-? 

SrMf-T4 i: k fct, tffiBIB»$iJffll§|5^^^ (IMffJQ ffl 
CRN) LTSfl Lfc^x-^OWMSr^R-f 4 <t o iz 

[0027] JfiSH*- ^ U T;KEi*-r4 £ k tCk 
•9, #IBttfJ«^*^^7 ;: -^&S{i-r4^iJ{J:Ix^h 

&tw. mmmmizmmLx-mzm^-r-iycommz 

•^4 £ k s ^ttW^B^frk LTBpe^»# 
&H3El-r4£k^Brtgk^4o 

[0 0 28 1 *»^«?DfB3<0«ffitt. 7?fii 

-^<oig»*ffiwr4 fz^mmmmmmxh-ox , m 

-y^A7J#ak. mmT-?t,zm-?XT7j~^-?co 

it* xiv 9 izx -ixMfezti&fflwfflmizmm tx%m 
[0029] frfrtnf&nmmmmziituis:^ 

k M vii-r £ k £ J; -5 T . Wfflm. *M±% ^ 

4£k^< , IWilliSI^fM • ^-x-y 
tOK" 4<Ik*»T"#4. 

[0030]f^fy-' f-x-ySNBS*tfc4HB»W» 
^»<7>raTii. JBS^r - ^ 2:SfS-r 4^J«K« k 3r 
4„ U3&»L**»/»s #SS»&96B<0^n-y^fi-9*fflv^ 
4 £ k izX 0 , SWaMtlsIsgLT-^cti^-^w 
M31^^f-t4£fcA i T'§4„ itfOlSII. ^S-T^v-j-X 
-^(c i 4 HBS«aoiMlflWrlMP*»S-t 4 £ k *«r 
#gk^4„ 

[ 0 0 3 1 3 *^com3cOfl®C^4Wf[j»Kac 
SB (Universal Serial Bus) C 

{mzti&xd^mmyVTtymm. xt±. rs-23 



2 c tcftasji* =t 3 ttm-mnmy v tivwm^^ 
vvt#M*ij»!£ffira£xw ^- • i-^-ymmthz 

b<>zX *). WM.W.^M±^i>Zbts:<mm'f-^^ 
[0 0 3 2] 

[ ftffl ] *f£0J? « S T 7 * x - ? |g»W«^(4 , 
mmWmWi 4** 3 > hn-yb ffil£<7»* i: Tfl§ 

[0033] #iEM4 1 -fe >y hVT-fMlMt 1 -fe 

■wmfrtz zbx\ mmm^faxu i *<7>tm ^- • -f- 

-f ^-7i- x£ffl^T«j££ft.&„ 
[0034] ffifft^tfcttSrW ^- • f-i-VcO^ 

fc. -f^^*— • *h x.—y<T>W%A$, ^zxyhu— y{z 
IV— T ■ ^-vtZilX^t. 
[0035] ZCD£ oft? 4 ■ ^^ — yW&teH^ 
Ti4. &Wmmz1iifr?&mm?—?\i?f!W<>-5rV- Oh- 

mmmt. m^f- ? ^mmi-msm lt . 

V h n-5^&<3RJBffil9Mlf ? n >y ^fl#2r - 

mmzm^-th z fc#*T-# & . zcom^. mwsmm 
mmzmw-th z t § . 
[0036] ^wmz iixff s REw^coffla^ i ^-r, 

[0037] *wnco$ 4,tcfBcoB», wm-msu. 
mmm^zx^xmhMz^hxhh 3 . 

[0 0 38] 

[0 0 3 9] »D*7M OOCOA-H 1 ) 

$j|Otf".y M 0 0(4, **3yhD-7 10 k. cf 
fc«R<'5lH»5R2 0-l, 2 0-2-T»ft§*l6. PJ 

H^twf 4 . »^««(4 4 fflt-* s osm* 

[0040] %mWl&2 0 - 1 IBI6$Wi52 1 - 
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_ i . . . t CD^r -y h Tfl§j£ S tl h . ffiKt iJffllgP 21-1- 
54. 4j*r?>-hc?-9 l O^t^^fiTt^-r-^Sr 
#KILT. r^f-AX-^2 2-l-C»L , CKBe# 

; x— * 2 2 - 1 ••■coKKigSr^iB LTSEi&§fJ»i52 1 - 

«H±Sm r 7 f- aX- ? 2 2 - 1 •• -tjUti 
3lB6«fcWtP*3SB*-4 - i: #'T# & . 
I [004 1] #IBIW!lWgg2 1 - 1 , 2 1 - 2-{4, jt 

fflOy 'J 7* • ^- b 1 of of LT^S „ 
i J: ^fc. L{4. -Tf^ffiTJffl^ 

T/U • h ?r^-LJt-r-^<E3M^ ( fflftro h 3 
I ;l^) cop*ffl(--ov>T(4f*^ciiS. 

[0042] yy7^- 4 oTjS^^ix/i-r' 

: MS— ■ j-^—y^z&tf&ymvyi/VTiV- Hfi—Y. •? 

^h-hmmmmm 21-1 ^x-nm^ v tjv ■ h 
(4, 4>*3>-ho-5 1 ocom^-^mtim^vT 

-yizm-f&mkmvyVTiv ■ #—h, -f&h-hmm 
mm^2 1 - 4com<tim ] jt/v ■ tf-hii, w^y 

No-51 OcoATJffl^UT/U • df-btiSKSitrv^ 
I -I) „ dtf04 d^r-f ■ fx-yfisiiittis^t 
1 (4. #lg»^2 0 -1,20 

tBfH^ ^ 7 • 'J & Z t ifiX'^ h . 

[0043] ^yhn-7l 0(4, IMHz^IbIW 
! Slffffl ^o.y7ff^-i:20MHzcr» ; t-^ $iJfP^*fflJH 

OTS-^k^^-rs. zixhcommtuvvmmt. # 

► v7\mtLx\mztix\^„ 

[0044] ®mimw&2 1 - 1 •■•(4. ^—ftuvm 
nm<vmm{mz § $> lt. ikHzoy7i-> 

f 2 1 - l--Ktf«$tlTV^#T^f-a-X-^2 2 - 1 

•••(4^T. IBHKWtdiiJWStiS. <roft#kLT. 
3yba-510il 1 MHzcOpIffiMfiffl^o-y^cr) 
! * £ 2 1 - 1 • • • LT . # KnMflW 

2 1 - 1 -fcfcWt 2 OK H zcO^-?$lJ»«*fflMS! 
' ff-^k 1 kHz<7)V7 17x7 • -tf-^ff-^-^TJSr* 

r [0 04 5 ] ic04 d fcr. 1. kHzH^V7h7x7 

L • h^-xK»«Uc i *), 1 m s e c amzi%5FT-?<r>m 
3 JII* s ^T-tSC0T\ ^T(07yfxX-?2 2- 1 , 2 

t 2-2-zmmmzfflffl-t hztiftrst. 

[0046] mmmm^mm-rttzMzii, &wah& 



!( 6 ) 001-147706 (P2001-147706A) 



*i h mmmffl zm^^x marr- ? ommz mmmiz 
mzmw-th z t #-e# i) , 

[0047] JfcVvC, lEI&$iJffilg|52 1 #fif 3 «BHC-^ 
TSiBB-T S . ^S-IESftffHJfflJgP 2 111 1msec 

[oo48] ( i ) mmm» 
mom ft . h .'t-^ i wis^ £ t? a <r t a*-c t* 5 . 

[0049] fiatilWMM^Srff a*^s mMMff&2 1 

. t . is v t>v ■ hm^x-mhixx < h mjHaxa 
ti^r- * p r . f t s- m^A,x , ztibnf—f&fr 

[00 50] 

[»1 ] V ref = (P„,-P.) XG1 
V m = P m • s sli7r7Xi!f) 
T ref = < (V Mf -V.) X (1+G2/S) I XG3 

[00 5 1] fit, Gl, G 2. Sy'G3(±, *X h~t 

1 0*>£>^U T;WIflk:l 

2 111 Gl, G2. MfG3$:'mc&*khZbl l Z&~> 
X. m^-T—?P ief t,Ztt~f&T7i-x.^-? 2 2CDJ& 
SfcflMtM.* if: 

[0052]^, JMMMWWetfrd*^ KHrfHff 

»2iii 2i>zi-y23frhvkhfix<htm. : f-? 
p m k . i^D r;u • mi-csa hftx < i mmm 

cnm^f— ?P iet b£ S^iZXT" . i ti 4> Ot - * fit 
frh. T&lzm-MMZ'ff^. T?f\xX-:?2 2<9ia 

[0053] 
HS2] 

V n = P m • s s{i^Ti7X^»^) 
T ref = { (V ref -V m ) X (l+G2/s) } X G 3 
[0054] ifc, h/W?SMn^«rtrS*£fctt, IB 
K>tiiJffliSS2 lfi. Thx h-f"^r*)*>^*3ybn-7 1 0 

*» 6 u r/wm tc ± -> x m c>tix < h wk y ^ ? <r>m 

jLX~^|ffl6h;^T ref J: a*«SK*r 

7fj.i-^2 2 Li6& . 

[0055] ( 2 ) x'j 77W»aw«i 
KfcJhiBLfc.fcdte, IB«J*JffliSB2 Hi. r?**.x- 

^2 2«oa-5^-?s, ttffim^^-fKb'com-sf 
zfrxb-tzch-htp^yhv-^iob comxmm-t 

h^mbLX, ^UT/Wlfffcffl^S. at, *^ttM 



tts p^isisB^ur^afi^v^-r^^ffl-ri.cikt^r 

trc&S. ^-fticottZmmi-Xh. W^yfn- 
5 1 0fcJ|t$&LfclH1IWM*£, #IgWJ«g|52 1 - 1 

[00 56] |a]fl|>-U T/«ft^^ffffl t^*§-£\ a 
Sc«»ft0fflISP2 1 - 1 , 2 1 - 2 -if 5 LfcttflfftW: 
SSBW 6 - k tc «fc o T , ^iMT'y^fA 1 0 0 £ 

•ciSfrr^. -k* s T# sot. ascor^-f-j-x-^ 2 
2 - 1 , 22-2-0 mmmmmzmt hzb vx 

[0057] *Xlt LT04"*3^ha-5 1 0«± s 
7?fjX-?2 2- l-OftfJfPJMSSTSVt LTOl 
ms e ctttC^SL^ lW^fAl-i' 2 20|gW 
Mil 2 1 t«t & f I^t 1 "- f^miLX. y'J7;l- 

$&r4i?- ■ j-x.-ymmztifcMmzfe-ox, %m 

1MW2 1 - 1 -l,z£->xm& i %{E%tl& . 
[0058] fl^-*j&**MWW«»2 1 - 1 

2 tcM^-S »$(J«PSP 2 1 JSIW4 . ICfef- ^ £ f* 

-f • ^-^—y<^T^zmtthtinx'^ 
2 2<offttfHmv2 1 ^f-^^m-h 

b. Zti&WiLA,TfrhTJll£m£rt&. ZVX, f& 

[00 59] ;«J; d tcLT. 4"*3^hn-5 1 0*> 

Ti&^b—MLtiik, Ht/'^nyhn— ^ 1 OlzMZ 
fi&, Ltzt^X. Nfi<7)|giM2 0- 1 , 2 0-2, 
-, 2 0-N*iji«S§tlTV^^t;(4. NXT SV [m 
sec] 0$fMWJ^m-oT8g«I^f*^|BIWWfcflJP 

l. i/xir^ i o o^tmmmmm-t&z b&x* 

[0060] H2tte s cf^a^hn-^ 1 0^'4ffl 
c0lEttffi(l»^2 1 - 1 , 2 1 - 2-<DfflXfthtl&'r— 

?mmij^zmffiLx&<<7)xmmztht^K fit. * 
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ACTUATOR DRIVE CONTROL SYSTEM, MULTIAXIAL MACHINE DEVICE 
AND DRIVE CONTROLLER FOR ACTUATOR 



Detailed Description of the Invention 
[0001] 

Field of the Invention 

This invention relates to the actuator drive control system applied to the mechanical 
apparatus which comprises two or more actuators, such as a robot, general-purpose 
assembly apparatus, robot hand apparatus, and other multiaxial control devices, It is 
related with the actuator drive control system which can drive two or more actuators on a 
synchronous cooperation target especially. 

[0002] 

In detail, by using serial communication, with a small wiring number, this invention 
relates to the actuator drive control system which can be driven on a synchronous 
cooperation target, and especially two or more actuators by short-time serial 
communication. It is related with the actuator drive control system which can drive two 
or more actuators on a synchronous cooperation target. 

[0003] 

Description of the Prior Art 

The thing of a mechanical apparatus which performs movement modeled on operation of 
human being using the electric or magnetic operation is called "robot." It is said that the 
origin of a word of a robot originates in ROBOTA (slave machinery) of a slab word. 
Although it is in our country that a robot began to spread from the end of the 1960s, the 
many are the industrial robots (industrial robot) in a factory aiming at automation, full 
automation, etc. of production operation, such as a manipulator and a carrier robot. 
[0004] A robot is a mechanical apparatus which generally consists of two or more 
actuators for expressing joint flexibility. The encoder which measures displacement of an 
actuator and an actuator in the degree of each one means of a joint part, The drive system 
which consists of a drive control circuit which controls the drive of an actuator 
accommodative as indicated value is arranged feeding back the detecting signal of an 
encoder, and the drive system of a robot is constituted. A central controller controls the 
drive system of the whole robot in generalization so that a robot performs a 
predetermined operation pattern. 

[0005] 

In the case of a robot with the drive system of a multiple spindle, i.e., a large number, it is 
preferred that it is small and lightweight because of the simplification of entire structure. 
Since many joints whose degree of location which contains flexibility of two or more, 
such as a roll, a pitch, and a yaw, is high in the case of the robot which has joint 
flexibility of a huge number like a humanoid robot or a pet robot especially are included, 
if an actuator is large, each joint part part will be enlarged and will become ill-shaped. 
Wiring of the joint part circumference will also be crowded. Since the weight of the 
whole robot naturally also increases that an actuator is a heavy lift, it will be excessive [ 



the load which moving work takes ]. 
[0006] 

For example, it is indicated by the Japanese-Patent-Application-No. No. 33386 [ 1 1 to ] 
specification already transferred to these people about the small AC servo actuator of the 
type which was a gear direct attachment type, and one-chip-ized the servo control system 
and was built in the motor unit. This AC servo actuator is suitably [ for the joint of a 
robot ] applicable. 

[0007] 

In the mechanical apparatus of a multiaxial drive system like a robot, the 
synchronizations of each axis need to operate cooperatively. For example, in the leg 
formula mobile robot of a dipodia erect type like a humanoid robot, if the limbs do not 
perform predetermined coordination operation, a robot invites the situation of the abasia 
or a fall as a result which loses the stability of a posture. Breakage with a destructive 
robot may be received by fall, and considerable damage will also attain to the other party 
which collides by fall. 

[0008] 

As a multiaxial robot is mentioned above, when it comprises two or more drive systems 
and one central controller, cooperative operation of the whole body can be realized 
comparatively easily by sending directions of operation to each drive system, taking a 
synchronization in a central controller, for example, the whole body according [ if all the 
drive systems are connected to the local of a central controller in parallel, when a central 
controller will publish directions of operation simultaneously to each drive system, a 
synchronization is taken easily, and ] to each actuator - cooperative operation is 
realizable. 

[0009] 

However, if all the drive systems were connected to the central controller in parallel, the 
wiring density in the central controller circumference increases, and a design and 
assembly of a robot become complicated. Input/output port will have to be prepared 
according to the number of a drive system, the design of the central controller itself will 
also become difficult, and a central controller will cause cost escalation. Since increase of 
flexibility is accompanied by the increase in the number of ports of a central controller, it 
turns into that a designer's burden and cost are excessive. 

[0010] 

The easy method of canceling confusion of the wiring in a central controller will be 
stopping parallel connection of each drive system and connecting each drive system with 
a daisy chain mode using in-series serial interface. 

[0011] 

There are a start-stop serial communication method like RS(Recommended Standard)- 
232C and a synchronous method serial communication method in serial communication. 



[0012] 

With the former start-stop, start with a start bit, and data is transmitted by the bit string of 
the specified length of finishing with a stop bit, In a receiver, it is a method which detects 
these starts and a stop bit and identifies received data, and a bit string can be detected by 
the sampling frequency decided beforehand, and data can be recognized. However, this 
start/stop system has a slow transfer rate, and since send data follows the ASCII 
(American Standard Code for Information Interchange) code, data length will become 
long. For this reason, when daisy chain connection of two or more drive systems is 
carried out with a start/stop system, there is no guarantee that each drive system 
synchronizes and performs received data. A time delay will increase in proportion to the 
number of connection of a drive system. 

[0013] 

On the other hand, in the case of a synchronous serial communication method which is 
represented by USB (Universal Serial Bus), synchronous control is collateralized, but 
wiring will increase in proportion to the number of connection of a drive system. 
Therefore, if it is adopted as the mechanical apparatus of a multiaxial system, wiring will 
be crowded, and a design becomes difficult. 

[0014] 

Even if it is which above-mentioned serial communication method, when controlling two 
or more drive systems, the operation which carried out synchronous cooperation is not 
guaranteed. 

[0015] 

In order to guarantee a synchronization, a central controller will produce the overhead of 
both which are called communications control processing and drive controlling 
processing of an actuator. As a result, two or more central controllers are equipped, 
namely, it is obliged to a multiprocessor configuration. As a result, a course scale will be 
expanded and cost performance will be inferior. 

[0016] 

[Problem(s) to be Solved by the Invention]The purpose of this invention is to provide the 
outstanding actuator drive control system applicable to the mechanical apparatus which 
comprises two or more actuators, such as a robot, general-purpose assembly apparatus, 
robot hand apparatus, and other multiaxial control devices. 

[0017] 

The further purpose of this invention is to provide the outstanding actuator drive control 
system which can drive two or more actuators on a synchronous cooperation target. 

[0018] 

The further purpose of this invention is to provide the outstanding actuator drive control 
system which can drive two or more actuators on a synchronous cooperation target with a 
small wiring number by using serial communication. 



[0019] 

The further purpose of this invention is to provide the outstanding actuator drive control 
system which can drive two or more actuators on a synchronous cooperation target by 
short-time serial communication. 

[0020] 

Means for Solving the Problem 

This invention is made in consideration of an aforementioned problem, and the 1st side, 
A central controller which is an actuator drive control system for controlling a drive of a 
multiaxial mechanical apparatus which consists of two or more actuators, and publishes 
indicative data to each actuator, It comprises a drive control section which controls a 
drive of an actuator according to indicative data and which was provided for every 
actuator, Each of said drive control section includes a data input means which receives 
indicative data, and a data output means which transmits indicative data, One data output 
means is connected to a data input means of another side, drive control sections form a 
daisy chain, and said central controller is an actuator drive control system characterized 
by what indicative data is sent out for to a head of said daisy chain. 

[0021] 

Synchronous serial communication which is represented with an actuator drive control 
system concerning the 1st side of this invention by USB (Universal Serial Bus), Or 
indicative data can be transmitted by serial interface, such as start-stop serial 
communication which is represented by RS-232C. Indicative data can be transmitted by 
carrying out daisy chain connection of between each drive control section using serial 
interface, without increasing a wiring number. 

[0022] 

A clock supply means which supplies a common clock signal to each of said central 
controller and a drive control section is included, While said central controller publishes 
indicative data for every control cycle specified by this clock signal, each of said drive 
control section may be made to perform processing of indicative data received 
synchronizing with a control cycle. 

[0023]Although it becomes various [ time when each drive control section receives 
indicative data by transferring indicative data serially ], it becomes possible by 
performing processings of indicative data all at once synchronizing with a control cycle 
to realize instantaneous and cooperative operation of each actuator. 

[0024] 

A central controller which the 2nd side of this invention is a multiaxial mechanical 
apparatus which consists of two or more actuators, and publishes indicative data to each 
actuator, A drive control section which controls a drive of an actuator according to 
indicative data and which was provided for every actuator, While providing a connecting 
means which carries out daisy chain connection of each of said drive control section and 
connecting a head of said connecting means with an indicative data outputting part of 
said central controller, The tail end of said connecting means is a multiaxial mechanical 



apparatus characterized by what is connected with an indicative data input part of said 
central controller. 

[0025] 

Synchronous serial communication with which said connecting means is represented by 
USB (Universal Serial Bus) in a multiaxial mechanical apparatus concerning the 2nd side 
of this invention, Or indicative data can be transmitted by serial interface, such as start- 
stop serial communication which is represented by RS-232C. Indicative data can be 
transmitted by carrying out daisy chain connection of between each drive control section 
using serial interface, without increasing a wiring number. 

[0026] 

A clock supply means which supplies a common clock signal to each of said central 
controller and a drive control section is included, While said central controller publishes 
indicative data for every control cycle specified by this clock signal, each of said drive 
control section may be made to perform processing of indicative data received 
synchronizing with a control cycle. 

[0027] 

Although it becomes various [ time when each drive control section receives indicative 
data by transferring indicative data serially ], By performing processings of indicative 
data all at once synchronizing with a control cycle, each actuator can be made to drive 
simultaneously and it becomes possible to realize operation cooperative as the whole 
multiaxial mechanical apparatus, 

[0028] 

A data input means which the 3rd side of this invention is a drive controlling device for 
controlling a drive of an actuator, and inputs indicative data, A data output means which 
outputs indicative data, and a clocked into means to input a clock signal, It is a drive 
controlling device for an actuator characterized by what a treating part which controls a 
drive of an actuator according to indicative data is provided, and said treating part 
performs processing of indicative data received synchronizing with a control cycle 
specified with an inputted clock for. 

[0029] 

It can do [ carrying out daisy chain connection of two or more drive controlling devices, 
or ], without increasing the total wiring number by repeating connection between a data 
input means of one device, and a data output means of a device of another side according 
to the drive controlling device of this composition. 

[0030] 

Between each drive controlling device by which daisy chain connection was carried out, 
time which receives indicative data becomes various. However, synchronizing with a 
control cycle, processings of indicative data can be performed all at once by using a clock 
signal with each common device. As a result, it becomes possible to realize instantaneous 



and cooperative operation by each actuator. 



[0031] 

In a drive controlling device concerning the 3rd side of this invention, said data input 
means and a data output means, It may be made to exchange indicative data by serial 
interface, such as synchronous serial communication which is represented by USB 
(Universal Serial Bus), or start-stop serial communication which is represented by RS- 
232C. Indicative data can be transmitted by carrying out daisy chain connection of 
between each drive controlling device using serial interface, without increasing a wiring 
number. 

[0032] 
Function 

The actuator drive control system concerning this invention is suitably applied, when it 
constitutes a multiaxial mechanical apparatus from a central controller and two or more 
drive systems. 

[0033] 

Each drive system has an one set data input part and an one-set data output part. It is that 
one data output part and the data input part of another side connect between adjoining 
drive systems, and it serves as daisy-chain-connection composition of one in the whole 
drive system. Each data input/output is constituted using serial interface. 

[0034] 

The tip of the daisy chain in a drive system is connected with the data output part of a 
central controller, and it acts to the central controller as a loop back of the back end of a 
daisy chain. 

[0035] 

In such a daisy chain configuration, the indicative data to each drive system is transmitted 
by what is called a bucket brigade method. In order to realize synchronous control, after 
receiving indicative data, each drive system can once stand by, can make each control 
synchronization the same in inputting the control clock signal for a synchronization from 
a central controller, and can perform processing of indicative data synchronous. As a 
result, each drive system can operate cooperatively. 

[0036] 

According to this invention, it is not based on the number of a drive system, but the 
wiring for data communications is constant. For example, even if it is a case where the 
mechanical apparatus of huge flexibility composition is developed like a humanoid robot, 
a designer is released from the problem of confusion of wiring. Since a wiring number 
does not change, a design variation can increase the number of a drive system freely. 

[0037] 

The purpose, the feature, and advantage of further others of this invention will become 
clear [ rather than ] by detailed explanation based on the example and the drawing to 



attach of this invention mentioned later. 
[0038] 

[Embodiment of the Invention]Hereafter, the example of this invention is explained in 
detail, referring to drawings. 

[0039] 

The hardware constitutions of the multiaxial robot 100 are typically shown in drawing 1. 
As shown in the figure, the multiaxial robot 100 comprises two or more drive-system 20- 
1,20-2 ~ connected to daisy chain form to the central controller 10 and the central 
controller. In the example shown in the figure, although the number of a drive system is 
four pieces, the number in particular is not limited. Hereafter, each part is explained. 

[0040] 

each drive-system 20-1 ~ Drive control section 21-1 -, actuator 22-1- and the encoder 
23-1 - it comprises a set. Drive control section 21-1 — processes the indicative data 
published from the central controller 10, and supplies a driving signal to actuator 22-1 
Encoder 23-1 - can realize accommodative control of as opposed to [ detect drive 
quantity, feed back to drive control section 21-1 — , and / based on this detecting signal ] 
actuator 22-1 — in drive control section 21-1 — of actuator 22-1 --. 

[0041] 

Each drive control section 21-1,21-2 - has a serial port for an indicative data input, and 
every one serial port each for an indicative data output. As for adjoining drive control 
sections, one serial port for an output is connected to the serial port for an input of 
another side by the serial cable like a graphic display. 

As the whole drive system, it becomes the daisy-chain-connection composition of one. 
The after-mentioned is yielded about the details of the data transfer method 
(communications protocol) through a serial port. 

[0042] 

The serial port of the head in the daisy chain connected by the serial cable, i.e., the serial 
port for an input of the drive control section 21-1, is connected to the serial port for the 
indicative data output of the central controller 10. The serial port at the tail end in this 
daisy chain, i.e., the serial port for an output of the drive control section 21-4, is 
connected to the serial port for an input of the central controller 10. In such daisy-chain- 
connection composition, the indicative data to each drive-system 20-1,20-2 - can be 
transmitted by what is called a bucket brigade method. 

[0043] 

The central controller 10 generates the 1 MHz clock signal for synchronous 
communications, and the 20-MHz periodic signal for a motor control operation. These 
synchronizing clock signals are supplied as a clock signal of common synchronous 
control to each drive control section 21-1 



[0044] 



Each drive control section 21-1 - carries out dividing of the periodic signal for a motor 
control operation further, and generates the software servo cycle of 1 kHz. Therefore, 
each actuator 22-1 ~ of all connected to drive control section 21-1 - is controlled 
synchronous. As this substitution, the central controller 10 can supply only the 1-MHz 
clock for synchronous communications to each drive control section 21-1 — , and can also 
generate the both sides of the 20 kHz periodic signal for a motor control operation, and a 
1-kHz software servo signal in each drive control section 21-1 --. 

[0045] 

Thus, since transmission of indicative data is completed within 1 msec, all the actuator 
22-1,22-2 - is controllable by the software servo cycle of 1 kHz synchronous. 

[0046] 

In order to realize synchronous control, each drive system can make each control 
synchronization the same in inputting the control clock signal for a synchronization from 
a central controller. ****** and drive control section 21-1 -- of each drive system can 
once stand by, after receiving indicative data, and they can perform processing of 
indicative data synchronous using the control cycle specified with a clock signal. As a 
result, each whole drive system can operate cooperatively. 

[0047] 

Subsequently, the processing which the drive control section 21 performs is explained. 
Each drive control section 21 performs control calculation and serial transfer control for 
every servo interrupt signal generated for every msec. 

[0048] 

(1) The control calculation drive control section 21 can perform position control 
operation, speed-control operation, and a torque control action as a control system. 

[0049] 

When performing position control operation, the drive control section 21, Position data 
P m sent from the encoder 23 and indicative data P re f of the rotary place sent via a serial 
port are read, from these data values, the operation shown in a lower type is performed 
and running torque T re f of the actuator 22 is computed. 

[0050] 

[Equation l]V re KPrerPm) xG 1 V m =P m ands (notes: s Laplace operator) 
T re f={(V re rV m ) x(l+G2-/s)} xG3 

[0051] 

However, Gl, G2, and G3 are control gain parameters set by serial communication from 
the host 10, i.e., a central controller. The drive control section 21 can change the response 
of the actuator 22 to indicative data P re f by changing Gl, G2, and G3. 



[0052] 



When performing speed-control operation, the drive control section 21, Position data P m 
sent from the encoder 23 and indicative data P re f of the rotary place sent via a serial port 
are read, from these data values, the operation shown in a lower type is performed and 
running torque T re f of the actuator 22 is computed. 

[0053] 
[Equation 2] 

V m =P m ands (notes: s Laplace operator) 

T re f={(V r erV m ) x(l+G2-/s)} xG3 [0054]In performing a torque control action, the drive 
control section 21, Indicative data T re f of the running torque sent by serial communication 
is read from the host 10, i.e., a central controller, and the actuator 22 is made to supply 
current which generates actuator running torque T re f based on this data. 

[0055] 

(2) a serial communication system — as already mentioned above, serial communication 
is used for the drive control section 21 as a method of communicating the signal of the 
parameter change of the actuator 22, a monitor of an internal signal, etc. among the hosts 
10, i.e., a central controller. However, in this example, it is also possible as a serial 
communication method to adopt any of synchronous serial communication or start-stop 
serial communication. Even if it adopts which method, there is no change in each drive 
control section 21-1 — receiving the control instruction which stemmed from the central 
controller 10 according to the downstream of a daisy chain, and executing a command. 

[0056] 

When a synchronous serial communication method is adopted, it is two or more drive 
control section 21-1,21-2. — The system 100 can consist of little wiring by connecting 
comrades in in-series. Since a high speed and the control signal which synchronized can 
be transmitted via a serial signal according to the synchronous serial communication 
method, it is two or more actuator 22-1,22-2. — Synchronous drive controlling is 
realizable, 

[0057] 

The central controller 10 as a host publishes the indicative data to the drive control 
section 21 of the one actuator 22 of actuator 22-1 — specified for every msec as the 
control cycle TSV, and sends it out from a serial port. This indicative data is received one 
by one by each drive control section 21-1 — according to the turn by which daisy chain 
connection was carried out as shown in drawing L 

[0058] 

While each drive control section 21-1 — is transferred serially to indicative data one by 
one, data is not itself incorporated only by transmitting indicative data under the daisy 
chain other than drive control section 21 about the specified actuator 22. On the other 
hand, if indicative data is received, the drive control section 21 of the specified actuator 
22 will be caudad transmitted, after incorporating this. And indicative data reception is 
answered, this is processed and it changes into the data for actuator control. 



[0059] 

Thus, the indicative data which the central controller 10 published is again returned to the 
central controller 10, after taking a round from the higher rank of a daisy chain to a low 
rank. Therefore, N drive-system 20-1,20-2, -, when 20-N is connected, the whole drive 
system can be controlled synchronous by the control cycle of NxTsv [msec], and 
coordination operation of the system 100 can be realized. 

[0060] 

In drawing 2, since the central controller 10 and four data transfer methods of drive 
control section 21-1,21-2 - held in between are illustrated, please refer to it. However, 
the control cycle in the central controller 10 was set to 1msec, and control cycle T S v of 
each actuator was set to 1msec. 

[0061] 

As shown in drawing 2, it answers that the control cycle of 1msec begins, While the 
following indicative data is sent out on a serial port, each drive control section 21-1,21-2 
-- processes the received indicative data, and the central controller 10 is actuator 22-1,22- 
2. — A drive is controlled. In other words, it synchronizes with the start of a control cycle 
and is each actuator 22-1,22-2 all at once. - Coordination operation is carried out. 

[0062] 

It is carried out after the cooperation drive controlling of an actuator is completed at the 
head of the control cycle of 1msec before the control cycle with same bucket brigade of 
the following indicative data expires. 

[0063] 

In the drive control system concerning this example, since indicative data is transferred 
serially, the time when each drive control section receives indicative data becomes 
various. However, please understand enough the point that each drive control section 22 
becomes possible [ realizing instantaneous and cooperative operation of each actuator by 
performing processings of indicative data all at once synchronizing with a control cycle ] 
to be shown in drawing 2. 

[0064] 

In drawing 3, since the example of a data format of the indicative data to which a daisy 
chain top is transferred serially is illustrated, please refer to it. One frame is constituted 
from top synchronous character data and 1 byte (8 bits) by the example shown in the 
figure at the main part of data transmitting of several byte length, and the synchronous 
character at the tail end. In the figure, the synchronous character 1 is indispensable and its 
synchronous character 2 is arbitrary. 

[0065] 

According to the composition of the system 100 concerning this example, the data stream 
which connects the central controller 10 and each drive-system 20-1 — can consist of only 
three kinds of signal wires called a serial-data sending signal, a serial-data input signal, 
and a synchronizing clock signal. Therefore, the wiring design in the mechanism part 



which has a complicated structure like a multiaxial robot can be simplified. 
[0066] 

Since the cycle of communication transmission and actuator drive control synchronizes, 
the directions to the actuator by a serial signal accelerate. Therefore, when carrying out 
kinematic control in a system like a multiaxial robot, it is possible to control the position, 
speed, and acceleration which consist of composition of two or more actuator output 
shafts synchronous, and whole body cooperation type operation can be realized. 

[0067] 
Supplement 

It has explained in detail about this invention, referring to a specific example above. 
However, it is obvious that a person skilled in the art can accomplish correction and 
substitution of this example in the range which does not deviate from the gist of this 
invention. That is, with the gestalt of illustration, this invention has been indicated and it 
should not be interpreted restrictively. In order to judge the gist of this invention, the 
column of the claim indicated at the beginning should be taken into consideration. 

[0068] 

Effect of the Invention 

As a full account was given above, according to this invention, the outstanding actuator 
drive control system applicable to the mechanical apparatus which comprises two or 
more actuators, such as a robot, general-purpose assembly apparatus, robot hand 
apparatus, and other multiaxial control devices, can be provided. 

[0069] 

According to this invention, the outstanding actuator drive control system which can 
drive two or more actuators on a synchronous cooperation target can be provided. 

[0070] 

According to this invention, the outstanding actuator drive control system which can 
drive two or more actuators on a synchronous cooperation target with a small wiring 
number by using serial communication can be provided. 

[0071] 

According to this invention, the outstanding actuator drive control system which can 
drive two or more actuators on a synchronous cooperation target can be provided by 
short-time serial communication. 

[0072] 

According to this invention, it is not based on the number of a drive system, but the 
wiring for data communications is constant. For example, even if it is a case where the 
mechanical apparatus of huge flexibility composition is designed and developed like a 
humanoid robot, a designer is released from the problem of wiring. Since a wiring 
number does not change by a design variation, the number of a drive system can be 



increased freely. 

Brief Description of the Drawings 

[Drawing 1] It is a figure showing typically the hardware constitutions of the multiaxial 
robot 100 suitable for realizing this invention. 

[Drawing 2] It is a chart illustrating the central controller 10 and the data transfer method 
of each drive control section 21-1,21-2 - held in between. 

[Drawing 3] It is a figure showing the example of a data format of indicative data. 

Description of Notations 
10 — Central controller 

20 -- Drive system 

21 Drive control section 

22 — Actuator 

23 — Encoder 



Claims 



[Claim l]An actuator drive control system characterized by comprising the following for 
controlling a drive of a multiaxial mechanical apparatus which consists of two or more 
actuators. 

A central controller which publishes indicative data to each actuator. 
A data input means which controls a drive of an actuator according to indicative data and 
in which it comprises a drive control section provided for every actuator, and each of said 
drive control section receives indicative data, and a data output means which transmits 
indicative data. 

[Claim 2] The actuator drive control system according to claim 1 by which it is 
characterized [ which transmits indicative data by synchronous serial communication or 
start-stop serial communication ]. 

[Claim 3] While publishing indicative data for every control cycle as which said central 
controller is specified by this clock signal including a clock supply means which 
furthermore supplies a common clock signal to each of said central controller and a drive 
control section, The actuator drive control system according to claim 1 characterized by 
what each of said drive control section performs processing of indicative data received 
synchronizing with a control cycle for. 

[Claim 4] A multiaxial mechanical apparatus characterized by what the tail end of said 
connecting means is connected with an indicative data input part of said central controller 
for while having the following and connecting a head of said connecting means with an 
indicative data outputting part of said central controller. 

A central controller which is a multiaxial mechanical apparatus which consists of two or 
more actuators, and publishes indicative data to each actuator. 

A drive control section which controls a drive of an actuator according to indicative data 
and which was provided for every actuator. 

A connecting means which connects each of said drive control section to a target one by 
one. 

[Claim 5] The multiaxial mechanical apparatus according to claim 4 characterized [ 
which transmits indicative data by synchronous serial communication or start-stop serial 
communication ] by said connecting means. 

[Claim 6]While publishing indicative data for every control cycle as which said central 
controller is specified by this clock signal including a clock supply means which 
furthermore supplies a common clock signal to each of said central controller and a drive 
control section, The multiaxial mechanical apparatus according to claim 4 characterized 
by what each of said drive control section performs processing of indicative data received 
synchronizing with a control cycle for. 

[Claim 7] A drive controlling device for an actuator characterized by what it has the 
following and said treating part performs processing of indicative data received 



synchronizing with a control cycle specified with an inputted clock for. 

A data input means which is a drive controlling device for controlling a drive of an 

actuator, and inputs indicative data. 

A data output means which outputs indicative data. 

A clocked into means to input a clock signal. 

A treating part which controls a drive of an actuator according to indicative data. 

[Claim 8] A drive controlling device for the actuator according to claim 7 characterized [ 
which exchanges indicative data by synchronous serial communication or start-stop serial 
communication ] by said data input means and a data output means, 

[Claim 9] A drive controlling device for the actuator according to claim 7 characterized 
by the ability to connect said data output means to a data input means of other drive 
controlling devices while said data input means is connectable with a data output means 
of other drive controlling devices. 



